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WAIT FOR 
SERVO START 
TO BEGIN NEXT PASS 



SERVO START 
CODE EVENT 



-210 



^215 



PRODUCE PosErr Signal BASED ON THE 
DIFFERENCE BETWEEN AN INDICATED POSITION 
AND A TARGET POSITION 
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CALCULATE A NOMINAL 
CONTROL EFFORT SIGNAL 



T 
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START 
A/D CONVERSION 
OF SENSOR SIGNAL 



EXECUTE OTHER CODE 
FOR AT LEAST 2USEC. 
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READ THE A/D 
SCALE THE A/D READING 
MULTIPLY BY THE GAIN FOR THIS PASS 
ADD THE RESULTING VALUE TO THE DAC ERROR 



EXECUTE OTHER CODE 



SEE FIG. 6B 



.240 



OUTPUT THE ADJUSTED CONTROL EFFORT 
TO THE DAC 
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CALCULATE THE GAIN TO BE USED 
FOR THE NEXT PASS 



SEE FIG. 6C 
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FIG 6A 
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READ THE A/D 
8 BIT VALUE 



CONVERT READ VALUE TO A 
16 BIT TWO'S COMPLEMENT VALUE 



SAVE THE 16-BIT 2'S COMPLEMENT VALUE 



I 



OFFSET THE READING TO THE 
MIDDLE OF THE A/D RANGE 



MULTIPLY SAVED VALUE BY 
THE PREVIOUS GAIN VALUE 



SCALE THE RESULTS 
OF THE MULTIPLICATION 
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SAVE THE SCALED VALUE 



ADD SCALED VALUE TO DAC VALUE 



T 
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FIG 6B 
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USE -10 OR +10 
SET DeltaG TO THE LIMIT 




DONT LET THE GAIN 
CHANGE TOO RAPIDLY 



26 



NO 



USE -100 OR +100 
SET AffGain TO THE LIMIT 



DONT LET THE GAIN 
GET TOO BIG 
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NO . ^IS GAIN CHANGE 
WITHIN LIMIT? 
-10 < DeltaG < 10 



YES 
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ADD DeltaG TO 
AFFGAIN 




259 



YES 



FIG 6< 



